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ABSTRACT 


' — The  problem  of  determining  the  location  of  a  fixed  point  using  range  only 
data  occurs  in  a  variety  of  areas  including  military  applications.  An  example 


is  outlined  below  and  formed  the  incentive  for  the  work  herein.  The  application 
consisted  of  precisely  locating  hydrophones  placed  on  a  ship's  hull  for  the 
purpose  of  receiving  acoustic  signals  to  be  used  in  calculating  torpedo  positions 
during  a  test.  In  this  paper  a  method  is  developed  which  under  the  assumption 
of  fixed  system  error  input  (in  range  data)  produces  the  smallest  possible 
error  in  locating  the  hydrophones.  . 


-0ur  goal  is  to  determine  the  coordinates  of  a  point  in  3-dimehsional 

'fi 1/5 

space.  For  the  purpose  of  simp! i city -we-  first  investigates  the  2-dimensional 

A 


version  of  this  problem  and  then  extend^ t  to  the  3-dimensional  case. 


<r 


The  determination  of  the  coordinates  of  a  point  in  the  plane,  requires 
a  minimum  of  two  observations.  We  investigate  the  geometry  of  that  situation. 

Let  positions  1  and  2  be  the  known  observer  positions  with  d  the  distance 

between  them  while  p  is  the  hydrophone  position  which  is  to  be  determined. 

We  assume  a  coordinate  system  with  1  at  the  origin  and  with  x-axis  defined  by 

1  and  2.  The  associated  figure  is  below  in  which  r*  and  r2  are  the  re¬ 

spective  ranges  from  observers  1  and  2  to  p  and  9,  a  are  the  indicated 
angles. 


1 


The  figure  is  redrawn  below  with  indicated  errors  Arlf  Ar2,  Ae  respec 
tively  in  the  ranges  r\9  r2  and  in  the  angle  0  .  An  associated  new 
location  point  p-  determined  from  the  ranges  with  errors  is  also  drawn. 


\ 


Two  Dimensional  Triangularization  with  Errors  in  the  Ranges 


2 


The  vector  difference  between  positions  P  and  ?'  is  indicated  by  AP 
and  is  seen  to  be  made  up  of  two  components,  namely  the  component  Arj  along 
rj  and  the  component  rjAe  perpendicular  to  rj.  Thus  with  1?!  and  le 

as  unit  vectors  along  rj  and  perpendicular  to  it  respectively,  we  have  the 
vector  equation: 

1 )  AP  =  riAel  is  +  Arjl  rj 

Next,  according  to  the  law  of  cosines,  we  obtain  2a)  and  2b)  while  2c)  is 
justified  by  the  law  of  sines. 


2a)  coa  a  =  ri2  +  r?2  -  d2 

2r777 


2b)  c.06  0  =  rx2  +  d2  -  r22 

2r*d 


2c)  ^  =4«0 


i>AJA  a 


Forming  the  total  differential  of  2b),  simplifying  and  solving  for  A0  gives 


3)  A0  =  -  1 


rxd  A-cn  e 


C12  +  r?2  -  d2  Arj  -  r2A r: 


2r, 


Next,  by  using  2a)  we  get 


4)  A8  =  -  r2 


rfd  bin  e 
and  by  2c)  after  simplifying 

5)  A0  =  -  1 _ 


coa  a  Arj  -  A r2 


ri  A-c n  a 


coa  a  Arj  -  Ar2 


so  that  after  multiplying  by  r\ 


Using  absolute  values  to  consider  the  worst  case  situations,  i.e.  where  the 
contributions  to  riA9  from  Arj  and  Ar2  add  up,  we  get 


7)  I r 1 A8 1  m  | Ar 1  COA  a|  +  | Ar2 I 

TZn~a 

It  is  clear  that  7)  that  for  given  errors  Ar*,  Ar2  then  the  minimum  of  the 
worst  case  situation  for  r^A0  and  hence  for  ||a£||  occurs  when  a  =  u/2,  i. 
when  the  lines  of  sight  from  1  and  2  to  P  are  perpendicular. 

Extension  to  the  3-Dimensional  Case 

The  previous  analysis  suggests  the  following  rule  for  obtaining  the 
minimum  error  in  locating  the  point  P  in  3-dimensional  space.  For  a  given 
set  of  range  errors  from  the  observers,  then  in  the  worst  case,  the  resulting 
vector  error  in  locating  the  point  P  will  be  smallest  in  magnitude  if  the 
respective  lines  of  sight  from  the  observers  are  mutually  perpendicular. 

This  conclusion  is  also  born  out  by  the  following  alternate  analysis: 

Let  x,y,z  be  the  unknown  coordinates  of  the  point  P  and  x^,  y^,  z^ 
the  coordinates  of  the  k—  observer  and  r^  the  range  from  the  k—  observer 
to  P.  Consider  the  system  of  equations 

8)  >/(x-xsk)2  T  <*-ysk)*  ♦  rk  k=i,2  ,3 

The  procedure  used  to  solve  8)  is  detailed  later  but  is  based  on  forming 
an  approximate  solution  Xg,  yg,  Zg  to  8)  and  making  a  correction  5x,  5y,  6z 
to  Xg,  yg,  Zg.  That  correction  is  the  solution  of  the  linear  equations 


k  =  1,2,3 


9)  (x0-x$k)5x  +  (yn-ycJsy  +  (zn-z„j5z 


0  ■'sk' 


■0  skj 


6r, 


k,0 


wfere:  rk>0  ’Ax0-xsk )*  ♦  (yQ-ysk)2  +  <V2sk>2  and  5rk  "  <Vk,o> 
the  residual  in  solving  8)  by  the  approximate  solution. 


Writing  M  as  the  matrix 
10) 


M  = 


V  XS1 
rl.O 


xn  -  x, 

0  S2 


2,0 


x0  ■  XS3 


3,0 


y0  -  ysi 

ri,o 

y0  -  yS2 

r2,0 

y0  -  yS3 
r3,0 


z0  '  2SI 

ri.o 


Z-,  -  Z 
0  S  2 


2,0 


zn  -  z  „ 
0  S3 


3,0 


then  9)  is  the  system  of  linear  equations 

ID 


Sx 

6r  i 

M 

5y 

= 

6r2 

5Z 

<Sr3 

If  r^  is  in  error  by  Arfc  then  also  5rk  is  in  error  by  A(6rk)  =  Ark 
Define  the  vectors 

12a)  A(fir)  =  ( A( 6r ! ) ,  A(6r2),  A(5r3)) 

12b)  Ap  (a(6x),  A(6y),  a( 5z ) ) 

so  that  in  the  Euclidean  norm 

12c)  |  |  A(tr)  |  !  =/  [A(6r!)]2  +  [A(5r2)]2  +  [A(5r3)]2 

1 2d )  ||A?||  =  J  C A ( 6x ) 3 2  +  [a( 6y)]2  +  [A(6Z)]2 


Then  referring  to  11),  it  is  well  known  that  for  a  given  set  of  A(6r  ) 

k 

k  =  1,2,3,  then  ||a?[|  will  be  smaller,  the  closer  is  the  condition  number 
of  M  to  one  (see  [1]).  By  examining  the  rows  of  M,  one  sees  that  these  rows 
are  (except  for  errors  in  the  matrix  terms),  unit  vectors  along  the  lines  of 
sight  from  observers  to  P.  Thus  if  these  lines  of  sight  are  made  mutually 
perpendicular  then  the  matrix  M  will  be  an  orthogonal  matrix  and  11)  then 
represents  an  orthogonal  transformation  between  (a£)  and  A(5r).  For  such 
a  transformation  the  condition  number  is  equal  to  one. 

Thus  for  the  triangulation  problem  in  3-dimensional  space,  a  given  set 
of  Arlf  Ar2,  Ar3 ,  will  produce  the  smallest  |)a?||  when  the  lines  of 
sight  from  the  observers  form  a  mutually  orthogonal  set  of  vectors. 

Such  a  situation  is  accomplished  in  the  following  figure  in  which  the 
three  observers  are  in  the  x-y  plane  and  point  P  is  below  the  x-y  plane. 


Method  of  Solution 


The  method  of  solution  used  is  linearized  least  squares  and  is  now 
described. 

Let  x<°>  y^  z<°>  be  an  initial  estimate  (the  method  of  determining 
this  will  be  described)  of  phone  position. 

We  seek  to  determine  hydrophone  coordinates  x,y,z  such  that  the  following 
equations  are  satisfied 

13)  v/(x-xsk)2  +  (y-ysk  )2  +  (z-zsk  )2  =  n<  k=l,...,m 


where  m  is  the  number  of  observations  and  rj<  is  the  observed  range  from  the 
k—  observer. 

Let  x(l),  y^,  be  the  estimates  of  phone  coordinates  after  i 
tions  and  let  r 
to  observer  k.  Thus 


iterations  and  let  rk  ^  be  the  associated  range  (computed  from  x^,  y^,z^ 


14)  a  /( x ( 1 ^ “Xjk ) 2  +  (yll|-ysk)2+  (zu'-zsk)2  =  rk 


,(i ) 


(i) 


(i) 


k=l , . . .  ,m 


The  correction  6x,  6y,  6Z  to  y^\  z^  is  computed  as  the  least 

squares  solution  of  the  system. 

15)  (x(i)-xsk)Sx  +  (y^-ysk)Sy  +  (z^-zsk)Sz  =  rk'rk  k=l,...,n 
— 


The  (i+l)st  estimate  of  phone  position  is  then 

16)  x(U,>  =  x(i>  ♦  6X  y«+1>  =  y'1’  +  6y  z(‘ 1 *'  >  =  >  ♦  Sz 


and  then  equations  15)  and  16)  are  re-solved  with  i+1  replacing  i.  Convergence 
of  the  process  is  accepted  when  the  change  in  phone  position  is  less  than  10~7 
on  successive  estimates. 

Initial  Solution  Point  for  Least  Squares  Technique 


An  initial  solution  point  is  necessary  in  order  to  use  the  linearized 
least  squares  iterative  technique  described  previously.  The  equations  for 
determining  that  initial  point  now  follow: 


The  figure  which  indicates  the  3-dimensional  triangularization  is  shown 
below  with  the  observers  indicated  by  1,  2,  3,  and  the  unknown  phone  by  P.  The 
x-y  plane  will  generally  coincide  with  the  surface  of  the  water.  For  ease  of 
illustration,  P  has  been  drawn  above  the  x-y  plane  when  in  reality  it  will  be 
below  that  plane.  However,  this  distinction  will  be  taken  care  of  by  the 
mathematics  to  follow.  In  addition:  a)  for  purpose  of  simplifying  the  mathe¬ 
matics,  the  y  axis  will  be  defined  as  passing  through  observers  1  and  2  with 
the  origin  at  observer  1  and;  b)  the  angles  u,  i  are  as  indicated  with  i  re¬ 
presenting  the  inclination  of  the  plane  containing  1,  2  and  P  to  the  x-y 
plane.  Z 


Geometry  for  Initial  Estimate 

Writing  the  coordinates  of  P  we  have: 

17)  P  =n  Ain  u  coa  i  P  =ri  coa  u  P  =n  Ain  a  Ain  i 

x  1  y  1  z  1 

and  with  C  ,  C  ,  C  as  the  coordinates  of  observer  3  then 
x  y  z 

18)  r 32  =  (rj  Ain  a  coa  i  -  C  )2  +  (rj  coa  u  -  C  )2  +  (r;  Ain  u  Ain  i  -  C  )2 

x  y  t- 


t. 


After  squarring  terms  out,  and  letting  S3  represent  the  distance  of  observer 
3  from  the  origin  so  that 


19)  S32  =  Cx2  +  C y2  +  Cz2 
we  get 

20)  r32  =  ri2  +  S32  -  2ri'Cy  £04  u. 

-Zr\  Ain  u  \J Cx2  +  Cz^j 


Cx  co 4  i 


+  Cz  Ain  i 


Cx2  +  cz2  7c72  +  cz2 


Defining  the  quantities 


21 )  CC4  t  =  Cx  Ain  t  =  -Cj 


\Axz  +  cz2 


>/  Cx2  +  C22 


and  using  a  trigonometric  identity,  we  solve  for  the  angle  x>t  from  20) 

22)  co4  (-c+t)  "  -r32  +  rj2  +  S32  -  2rjCy  co4  u 

2rj  Ain  u  y/Cx2  +  Cz2 

We  now  recognize  that  t  is  a  small  angle (assuming  C^O)  since  it  mea¬ 
sures  how  far  observer  3  is  out  of  the  x-y  plane  and  all  observers  will 
nominally  be  positioned  in  the  x-y  plane.  Thus  the  quadrant  of  i+ r  is  the 
same  as  the  quadrant  of  i.  Determining  i  from  21),  22)  and  the  remark 
following  22)  and  multiplying  by  minus  1  which  is  consistent  with  P  below 
the  x-y  plane,  -  we  complete  the  determination  of  i.  Then  use  17)  to  solve 
for  the  coordinates  of  P. 

Numerical  Results 

In  order  to  illustrate  the  effect  of  the  geometry  on  the  resultant 
accuracy  in  determining  the  phone  position,  a  number  of  computer  runs  were 


9 


made  with  noise  added  on  to  the  exact  ranges.  The  nominal  range  was  100  feet 
and  the  noise  was  generated  from  a  uniform  random  number  generator  with  mean  of 
zero  and  maximum  noise  magnitude  of  .1  ft  (which  is  representative  of  the  equip 
ment  being  used).  Using  the  ranges,  from  the  three  sightings,  each  run  had 
different  angles  between  their  respective  lines  of  sight  to  the  phone. 


We  give  the  results  as  errors  Ax,  Ay,  Az  in  determining  the  various 
components  x,y,z  of  hydrophone  position.  In  addition  we  also  list  the  square 
root  of  the  sum  of  the  squares  of  the  component  errors  and  call  this  ||a£||. 
Finally,  each  run  is  actually  the  result  of  four  sub-runs  each  with  a  different 
noise  sample.  The  results  listed  are  for  the  sub-run  with  the  largest  value 

of  ||tf||. 


Table  1 

Range  =  100  Feet 


Angle  between 
Lines  of  Sight 

ax (feet) 

Ay (feet) 

Az(feet) 

| 1 A^l 1  =VAX2  +  Ay2  +  AZ2 

15° 

.21 

.33 

.03 

.40 

30° 

.11 

.17 

.03 

.20 

0 

LO 

** 

.07 

.11 

.03 

.14 

60° 

.06 

.09 

.03 

• 

.11 

90° 

.04 

.06 

.04 

.09 

110° 

.03 

II 

.05 

.08 

: 

.11 

The  above  table  bears  out  the  theoretical  result  obtained  previously 


namely  that  the  errors  in  locating  the  hydrophone  are  minimized  when  the 
lines  of  sight  from  the  observers  to  the  hydrophone  are  mutually  perpendicular. 

The  method  considered  here  is  invariant  to  range  changes  and  this  is 


shown  by  running  a  case  with  the  ranges  at  1,000  feet. 


Table  2 


Angle  between 
Lines  of  Sight 


Range  =  1000  feet 


Ax( feet) 


Az(feet) 


A?||  =  v/ax2  +  Ay2  +  AZ2  ( feetl 


90c 


.04 


.09 


Conte,  S.D.  and  DeBoor,  C.,  Elementary  Numerical  Analysis,  McGraw-Hill 
1980. 
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